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FIG.42 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF 
PROVISIONAL DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS. 
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DETERMINE TERMINAL DIVERGENT COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EQUATION FROM BODY POSITIONAELOCITY (Xe,Vxe) AT END OF CURRENT TIME GAIT. 

qO[k] = Xe + Vxe/a>0 
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DETERMINE TERMINAL DIVERGENT COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EQUATION: 
errq = qO[k] - q" 
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CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF DESIRED ZMP 
OBTAINED BY ADDING CORRECTION TO PROVISIONAL DESIRED ZMP ACCORDING 
TO RELATIONSHIP OF FIG. 44, ASSUMING THAT a= A a. 
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DETERMINE TERMINAL DIVERGENT COMPONENT ql [k] ACCORDING TO THE FOLLOWING EQUATION 
ON THE BASIS OF BODY POSITION/VELOCITY (Xel,Vxel) AT END OF CURRENT TIME GAIT 
RECALCULATED ON THE BASIS OF DESIRED ZMP TO WHICH CORRECTION HAS BEEN ADDED: 

ql[k] = Xel +Vxel/a>0 



DETERMINE PARAMETER SENSITIVITY r ACCORDING TO THE FOLLOWING EQUATION: 
r = (ql[k]-qO[k])/Aa 



S714 



ADD CORRECTION AMOUNT BASED ON a=-errq/rTO PROVISIONAL 
DESIRED ZMP TO PROVIDE UPDATED PROVISIONAL DESIRED ZMP. 
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DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN ON THE BASIS OF 
DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGLE OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
BODY POSTURE ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGULAR 
VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY 
OF NORMAL GAIT. 



DETERMINE, AS DESIRED ZMP PATTERN, THE PATTERN OBTAINED BY ADDING BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN. 
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DETERMINE ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN ON THE BASIS 
OF DIFFERENCE BETWEEN TERMINAL ANTIPHASE ARM SWING ANGLE OF PROVISIONAL CURRENT TIME 
GAIT AND INITIAL ANTIPHASE ARM SWING ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF NORMAL GAIT. 
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INITIALIZATION 

TIME FOR GENERATING PROVISIONAL GAIT k=0 
TERMINAL STATE OF LAST TIME'S DESIRED GAIT THAT HAS BEEN CONVERTED 
TO CURRENT TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM IS TAKEN AS 
INITIAL STATE OF CURRENT TIME'S GAIT 
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